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ABSTRACT 

This  report  is  a  follow  on  to  the  report  given  in  DSTO-TN-0449  and  considers  the  derivation  of 
the  mathematical  model  for  aerospace  vehicles  and  missile  autopilots  in  state  space  form.  The 
basic  equations  defining  the  airframe  dynamics  are  non-linear,  however,  since  the  non- 
linearities  are  "structured"  (in  the  sense  that  the  states  are  of  quadratic  form)  a  novel  approach 
of  expressing  this  non-linear  dynamics  in  state  space  form  is  given.  This  should  provide  a 
useful  way  to  implement  the  equations  in  a  computer  simulation  program  and  possibly  for 
future  application  of  non-linear  analysis  and  synthesis  techniques,  particularly  for  autopilot 
design  of  aerospace  vehicles  executing  high  g-manoeuvres. 

This  report  also  considers  a  locally  linearised  state  space  model  that  lends  itself  to  better 
known  linear  techniques  of  the  modern  control  theory.  A  coupled  multi-input  multi-output 
(MIMO)  model  is  derived  suitable  for  both  the  application  of  the  modern  control  techniques 
as  well  as  the  classical  time-domain  and  frequency  domain  techniques.  The  models  developed 
are  useful  for  further  research  on  precision  optimum  guidance  and  control.  It  is  hoped  that  the 
model  will  provide  more  accurate  presentations  of  missile  autopilot  dynamics  and  will  be 
used  for  adaptive  and  integrated  guidance  &  control  of  agile  missiles. 
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State  Space  Model  for  Autopilot  Design  of 
Aerospace  Vehicles 


Executive  Summary 

Requirements  for  next  generation  guided  weapons  and  other  aerospace  vehicles, 
particularly  with  respect  to  their  capability  to  engage  high  speed,  highly  agile  targets  and 
achieve  precision  end-game  trajectory,  have  prompted  a  revision  of  the  way  in  which  the 
guidance  and  autopilot  design  is  undertaken.  This  report  considers  the  derivation  of  the 
mathematical  models  for  aerospace  vehicles  and  missile  autopilots  in  state  space  form. 
The  basic  equations  defining  the  airframe  dynamics  are  non-linear,  however,  since  the 
non-linearities  are  "structured"  (in  the  sense  that  the  states  are  of  quadratic  form)  a  novel 
approach  of  expressing  this  non-linear  dynamics  in  state  space  form  is  given.  This  should 
provide  a  useful  way  to  implement  the  equations  in  a  computer  simulation  program  and 
possibly  for  future  application  of  non-linear  analysis  and  synthesis  techniques. 

This  report  which  is  a  follow  on  report  to  DSTO-TN-0449,  also  considers  a  locally 
linearised  state  space  model  that  lends  itself  to  better  known  linear  techniques  of  the 
modern  control  theory.  A  coupled  multi-input  multi-output  (MIMO)  model  is  derived 
suitable  for  both  the  application  of  the  modern  control  techniques  as  well  as  the  classical 
time-domain  and  frequency  domain  techniques.  The  models  developed  are  useful  for 
further  research  on  precision  optimum  guidance  and  control.  It  is  hoped  that  the  model 
will  provide  more  accurate  presentations  of  aerospace  vehicles  autopilot  dynamics  and 
will  be  used  for  adaptive  and  integrated  guidance  &  control  of  agile  missiles  and  other 
aerospace  vehicles  that  do  not  necessarily  have  symmetric  cruciform  airframes. 
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1.  Introduction 


Requirements  for  next  generation  guided  weapons,  particularly  with  respect  to  their 
capability  to  engage  high  speed,  highly  agile  targets  and  achieve  precision  end-game 
trajectory,  have  prompted  a  revision  of  the  way  in  which  the  guidance  and  autopilot  design 
are  undertaken.  Integrating  the  guidance  and  control  function  is  a  synthesis  approach  that  is 
being  pursued  as  it  allows  the  optimisation  of  the  overall  system  performance.  This  approach 
requires  a  more  complete  representation  of  the  airframe  dynamics  and  the  guidance  system. 
The  use  of  state  space  model  allows  the  application  of  modern  control  techniques  such  as  the 
optimal  adaptive  control  and  parameter  estimation  techniques  [10]  to  be  utilised.  In  this  report 
we  derive  the  autopilot  model  that  will  serve  as  a  basis  for  an  adaptive  autopilot  design  and 
allow  further  extension  of  this  to  integrated  guidance  and  control  system  design. 

Over  the  years  a  number  of  authors  [1-3, 6-9]  have  considered  modelling,  analysis  and  design 
of  autopilots  for  atmospheric  flight  vehicles  including  guided  missiles.  In  the  majority  of  the 
published  work  on  autopilot  analysis  and  design,  locally  linearised  versions  of  the  model  with 
decoupled  airframe  dynamics  have  been  considered.  This  latter  simplification  arises  out  of  the 
assumption  that  the  airframe  and  its  mass  distribution  are  symmetrical  about  the  body  axes, 
and  that  the  yaw,  pitch  and  roll  motion  about  the  equilibrium  state  remain  "small".  As  a 
result,  many  of  the  autopilot  analysis  and  design  techniques,  considered  in  open  literature, 
use  classical  control  approach,  such  as:  single  input/single  output  transfer-functions 
characterisation  of  the  system  dynamics.  Bode,  Nyquist,  root-locus  and  transient  -response 
analysis  and  synthesis  techniques  [5,  7].  These  techniques  are  valid  for  a  limited  set  of  flight 
regimes  and  their  extension  to  cover  a  wider  set  of  flight  regimes  and  airframe  configurations 
requires  autopilot  gain  and  compensation  network  switching. 

With  the  advent  of  fast  processors  it  is  now  possible  to  take  a  more  integrated  approach  to 
autopilot  design.  Modern  optimal  control  techniques  allow  the  designer  to  consider  autopilots 
with  high-order  dynamics  (large  number  of  states)  with  multiple  inputs/ outputs  and  to 
synthesise  controllers  such  that  the  error  between  the  demanded  and  the  achieved  output  is 
minimised.  Moreover,  with  real-time  mechanisation  any  changes  in  the  airframe 
aerodynamics  can  be  identified  (parameter  estimation)  and  compensated  for  by  adaptively 
varying  the  optimum  control  gain  matrix.  This  approach  should  lead  to  missile  systems  that 
are  able  to  execute  high  g-manoeuvres  (required  by  modern  guided  weapons),  adaptively 
adjust  control  parameters  (to  cater  for  widely  varying  flight  profiles)  as  well  as  account  for 
non-symmetric  airframe  and  mass  distributions.  Typically,  for  a  missile  autopilot,  the  input  is 
the  demanded  control  surface  deflection  and  outputs  are  the  achieved  airframe  (lateral) 
accelerations  and  body  rates  measured  about  the  body  axes.  Other  input/ output  variables 
(such  as:  the  flight  path  angle  and  angle  rate  or  the  body  angles)  can  be  derived  directly  from 
lateral  accelerations  and  body  rates. 

This  report  considers  the  derivation  of  the  mathematical  model  for  a  missile  autopilot  in  state 
space  form.  The  basic  equations  defining  the  airframe  dynamics  are  non-linear,  however, 
since  the  nonlinearities  are  "structured"  (in  the  sense  that  the  states  are  of  quadratic  form)  a 
novel  approach  of  expressing  this  non-linear  dynamics  in  state  space  form  is  given.  This 
should  provide  a  useful  way  to  implement  the  equations  in  a  computer  simulation  program 
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and  possibly  for  future  application  of  non-linear  analysis  and  synthesis  techniques.  Detailed 
consideration  of  the  quadratic/ bilinear  type  of  dynamic  systems  is  given  in  [4]. 

This  report  which  is  a  follow  on  report  from  the  previous  report  [1,2],  also  considers  a  locally 
linearised  state  space  model  that  lends  itself  to  better  known  linear  techniques  of  the  modern 
control  theory.  A  coupled  multi-input  multi-output  (MIMO)  model  is  derived  suitable  for 
both  the  application  of  the  modern  control  techniques  as  well  as  the  classical  time-domain  and 
frequency  domain  techniques.  For  sake  of  clarity.  Figure  2.1  is  a  symmetric  cruciform  missile, 
however  the  models  developed  are  valid  for  non  axis-symmetric  aerospace  vehicles. 
Tables  A-l.l  to  A-1.3  contain  the  various  aerodynamic  derivatives  and  coefficients. 


2.  State  Space  Aerodynamics  Model 

The  airframe,  actuation  and  sensor  measurement  equations  have  been  derived  in  detail  in 
Appendix  A  in  this  section  we  give  the  main  results  that  will  be  used  for  matrix  based 
computation  of  the  state  space  model. 

2.1  Nonlinear  Airframe  Model 

Conventions  and  notations  for  vehicle  body  axes  systems  as  well  as  the  forces,  moments  and 
other  quantities  are  shown  in  Figure  2.1  and  defined  in  Table  2.1. 


Figure  2.1  Motion  variable  notations 


The  variables  shown  in  Figure  2.1  are  defined  as: 
m  -  mass  of  a  vehicle. 
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a  -  incidence  in  the  pitch  plane. 

P~  incidence  in  the  yaw  plane. 

X  -  incidence  plane  angle. 

a-  total  incidence,  such  that:  tan  a  =  tan  cr  cos  X,  and  tan  /?=  tan  cr  sin  X. 
T  -  thrust. 


Table  2.1:  Motion  variables 


Vehicle  Body  Axes  System 

Roll 

axis 

Pitch 

axis 

Yaw 

axis 

Angular  rates 

V 

q 

r 

Component  of  vehicle  velocity  along  each  axis 

U 

V 

w 

Component  of  aerodynamic  forces  acting  on  vehicle  along 
each  axis 

X 

Y 

z 

Moments  acting  on  vehicle  about  each  axis 

L 

M 

N 

Moments  of  inertia  about  each  axis 

I XX 

hy 

Izz 

Products  of  each  inertia 

lyz 

Izx 

Ixy 

Longitudinal  and  lateral  accelerations 

ay 

CLz 

Euler  angles 

e 

V 

Gravity  along  each  axis 

g* 

Sy 

gz 

Vehicle  thrust  along  the  body  axis 

T 

Tail  Control  Configuration: 

We  shall  use  the  following  notation:  £,  -  aileron  deflection;  rj  -  elevator  deflection;  g  -  rudder 
deflection.  Figure  2.2  defines  the  control  surface  convention.  Here  the  control  surfaces  are 
numbered  as  shown  and  the  deflections  (81,82,33,54  )  are  taken  to  be  positive  if  clockwise, 
looking  outwards  along  the  individual  hinge  axis.  Thus,  Aileron  deflection: 

£  =  —(84  +  82  +  83  +  84) ,  if  all  four  control  surfaces  are  active;  or  ^  =  —(84+83),  or 


%  =  — (82+84)  if  only  two  surfaces  are  active.  Positive  control  defection  (<£)  causes  negative 
2 

roll.  Elevator  deflection:  77  =  —  (84-83) .  Positive  control  deflection  (77)  causes  negative  pitch. 

2 

Rudder  deflection:  £  =  ^-(82-  84) .  Positive  control  deflection  (£)  causes  negative  yaw. 
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Figure  2.2  Control  surfaces  seen  from  the  rear  of  a  missile 

Canard  Control  Configuration: 

For  a  canard  configuration,  same  convention  will  be  used  for  control  surface  deflections; 
however,  it  is  noted  that  the  force  and  moment  coefficients  will  have  opposite  signs.  Canard 
control  is  generally  not  used  for  roll  control. 

Euler  Equations  of  Motion 

The  six  equations  of  motion  for  a  body  with  six  degrees  of  freedom  may  be  written  as  [1-3]: 


in  (  u  +  wq-vr)  =  X  +  T  +  gxm  (2-1) 

m(  v  +  ur-wp)  =  Y  +  gym  (2-2) 

m  (  w-uq  +  vp)  =  Z  +  gxm  (2-3) 

IxxP  -(Iyy-  Izz^r  +  Iyz(1‘2  ~  F  )  ~  !&(  P<l  +  r)  +  Ixy(  rp-q)  =  L  (2-4) 

Iyyq ~(IZZ~  I xx )rp  +  Izx(p2 -r2 )-Ixy(qr  +  p)  +  Iyz(pq -r)  =  M  (2-5) 

IZZ>‘  ~(IXX~  Iyy)P‘l  +  Ixy( F  ~  P2  )~  Iyz<rP  +  4)  +  Izx( q>  ~p)=N  (2-6) 

Here  (■)-—  -  is  the  derivative  operator. 


Based  on  the  Euler  equations  above,  the  nonlinear  (quadratic)  airframe  state  space  model  is 
given  by  (see  equations  A-l.l  to  A-1.5): 

(2-7) 
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Where: 


*1 


w 


M 


*2 


=  [u  v  w  |  p  q  r]r :  is  a  6x1  linear-state  vector. 


x 


w 


14 


=  [w#  wr  vp  vr  wp  wq  \  p2  pq  pr  q2  qr  r^|^:  is  a  12x1  quadratic- 


state  vector. 


■p- 


u 


w 


& 


=  [.V  +  T  Y  Z  |  Z,  M  ivf  :  is  6x1  a  vector  function  of  control  inputs,  forces 


and  moments. 

g 


g 


M- 


=  [sx  gy  gZ  0  0  •t  :  is  the  6x1  gravity  (or  disturbance)  vector. 


l 

0-3x1  \ 

fob 

’fo] 

1  [<>3x6 

1 

]  ' 

[^5x6  ] 

1 

i  fohfo] 

fob 

fox,] 

1  fox,] 

~ 

— 

1 - 

:  is 

fox, 

]  i  w 

- 

I XX 

1 

* 

1 

zx 

fob 

~~  I  xy 

for  -1 

yz  : 

r1* 

-fo*  lzz  \ 

0 

for 

fob 

—  I  zx 

(  ~IyZ  \ 

fo 

I  xy 

V  xx  ~  Tyy  ) 

:  is  a  6x12  state-coefficient  matrix. 


:  is  a  6x6  input-coefficient  matrix. 


:  is  a  3x3  matrix. 


-I 


xy  *  yz 


(fzz  I  xx )  ® 


1  yz  1  xy 


(‘yy-Izz) 

/v 


-I 


xy 

I 


zx 


yz 
I vc 

0 


:  is  a  3x6  matrix. 
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0 

0 

1 


0 

-1 

0 


0 

0 

-1 


1  0 
0  1 
0  0 


-1 

0 

0 


:  is  a  3x6  matrix. 


Subscripts  under  [i]  and  [0]  matrices  denote  the  matrix  dimensions.  Generally,  not  all  state 
variables  in  the  state  equation  are  accessible  or  measurable.  The  vehicle  angular  rate 
components  (roll  rate  p,  pitch  rate  q,  and  yaw  rate  r)  and  the  acceleration  components  (ax,  a,„ 
az)  are  commonly  available  and  can  be  measured  using  the  IMU. 

2.2  Body  Acceleration  Model 

Equations  for  the  vehicle  actual  body  accelerations  and  body  rates  are  derived  in  Appendix  A 
equations  (A-1.6)  to  (A-l.ll).  These  equations  allow  position  offsets  from  c.g  for  observing  the 
body  accelerations.  The  acceleration  components  at  point  O  (where  O  is  at  a  distance  of  dx,  dy 
and  dz  from  the  central  point  of  gravity,  c.g.,  along  x-,  y-  and  z-axis,  respectively),  may  be 
written  as: 

2  2 

ax  =  u  +  qw  -rv-dx(q  +r  )  +  dy( pq  -  r )  +  dz( pr  +  q) 

=  X  +  T  +  gx-dx(q2  +  r2  )  +  dy(pq-r)  +  dz(pr  +  q)  (2-8) 

ay=v  +  ru-  pw  +  dx(  pq  +  r  )-  dy(  p  +  r  )  +  dz(qr  -  p) 

=  Y  +  gy+dx(pq  +  r)-dy(p2+r2)  +  dz(qr-p)  (2-8) 

az  =  w  +  pv  -qu  +  dx( pr  -  q)  +  dy(qr  +  p)-dz( p  +q  ) 

=  Z  +  gz  +  dx(pr  -  q)  +  dy(qr  +  p)  - dz(p2  +  q2 )  (2-9) 

After  some  matrix  manipulations,  the  body  acceleration  model  may  be  written  as  (see 
equations  (A-1.6)  to  (A-l.ll): 

$ = MS + M  J,21  M'il]  (2-w) 

Where: 

=  \ax  (iy  «z] T  :  is  a  3x1  body  acceleration  vector. 

^  =  — 2  ^  =  \p  Q  rY  '■  is  a  3x1  body  rate  vector 
I  it  :  is  a  6x1  output  vector. 
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K]= 


10  0  0 
0  1  0  -dz 
0  0  1  d„ 


d , 


0 

-dx 


d 


:  is  a  3x6  accelerometer  position  'offset'  matrix. 


0  0  0  -1  0  1 

[»;]=  0  10  0  -10 

-1010  00 

position  'offset'  matrix. 


0  d„  d _  -  d  v  0  —  d . 


d  y  d  x 


0  0 


d%  d y 


' 0  dx 


■  d^  d  y 


:  is  a  3x12  accelerometer 


[K0\- 


[M0]  = 


[°3x6  ] 


[^3xi  I  ^3x3  ]. 


:  is  a  6x6  linear-state  output  coefficient  matrix. 


[DqFo+Dj] 

[°3xn\ 


:  is  a  6x12  quadratic-state  output  coefficient  matrix. 


[D0Go] 
ktxd 
[DoY 
[03x6] 


:  is  a  6x6  coefficient  matrix. 


:  is  a  6x6  output  coefficient  matrix. 


Note:  equation  (2-10)  represents  the  actual  accelerations  and  body  rates  outputs;  these  have  to 
be  measured  using  a  body  fixed  IMU  (accelerometers  and  gyros). 

2.3  Accelerometer  Dynamics  Model 

The  dynamic  model  for  the  accelerometers  is  derived  in  Appendix  A,  equations  (A-1.12)  to 
(A-1.17).  A  second  order  linear  dynamics  is  assumed  for  the  accelerometer  model. 

Jt^  =  [Wo\  ii]  +  [^]42]  +  [^3]47]  +  Klf[/]  (2-11) 

Where: 


*yo 


1  yo 


*zo 


T 


:  is  a  6x1  accelerometer  state  vector. 
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M= 


-0)x 

0 

0 

0 

0 


~  2CxO>x 
0 
0 
0 
0 


0 

0 

0 


0 

0 

1 


4 


-  col  -  2<Zy(Dy 


0 

0 


0 

0 


0 

0 

0 

0 

0 

-ml  - 


0 

0 

0 

0 

1 

Xz*z 


is  a  6x6  coefficient  matrix 


containing  accelerometer  parameters. 


M= 


0  0  0 

m2x  0  0 

0  0  0 

0  m2y  0 

0  0  0 

0  0  ml 


:  is  a  6x3  coefficient  matrix  containing  accelerometer  parameters. 


[fV2  ]  =  \}VjD0Fq  +W /£>/]:  is  a  6x12  coefficient  matrix. 

[/f  'j  ]  =  \fV i DqGq ] :  is  a  6x6  coefficient  matrix. 

\fV 4  ]  =  [h/  D()  ] :  is  a  6x6  coefficient  matrix. 

The  accelerometer  measurement  model  is  given  by  (see  equation  (A-1.18)): 

zj/]  =  [.//]  +  VW  +  vM  +  vW  +  vW  (2-12) 

—4  L  ' J  —4  -au  -a,i  -a„  '  > 


Where: 


$  =  [«x  ay  a'm  f :  *s  a  3x1  accelerometer  measurement  vector. 


vM-k  vv,  v_,  l7^ :  i 
— ah  L  xb  yb  zb  J 


is  a  3x1  accelerometer  bias  error  vector. 


-ab  L  xb  yb  Zb. 

=  [vv  ,  vv,  v7 ,  r  :  is  a  3x1  accelerometer  drift  error  vector. 

-aj  L  xd  yd  zd  J 


vW  =  [v 

vW=L 

— an  L 


:  is  a  3x1  accelerometer  scale  factor  error  vector. 


vyn  vZn  Y :  is  a  3x1  accelerometer  noise  error  vector. 
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[Jib 


1  0  0  0  0  0 
0  0  1  0  0  0 
0  0  0  0  1  0 


:  is  a  3x6  matrix. 


2.4  Gyro  Dynamics  Model 

The  dynamic  model  for  the  gyros  is  derived  in  Appendix  A,  equations  (A-1.19)  to  (A-1.21). 
A  second  order  linear  dynamics  is  assumed  for  the  gyro  model. 


>]#+[»>]  J/1 


Where: 


Po  Po  9o  0o  ro  ro 


:  is  a  6x1  gyro  state  vector. 


(2-13) 


M= 


0  10 
~0)2p  ~2<Zp(op  0 
0  0  0 

0  0  -G)q 

0  0  0 

0  0  0 


0 

0 

1 

'  2£q(Dq 
0 
0 


0 

0 

0 

0 

0 

-(Or  - 


0 

0 

0 

0 

1 

2£r(or 


is  a  6x6  coefficient  matrix 


containing  gyro  parameters. 


Kl= 


(Op 

0 

0 

0 

0 


0 

0 


oo, 


0 

0 

0 

0 

0 


0  (Or 


:  is  a  6x3  coefficient  matrix  containing  gyro  parameters. 


[w7]=[o 


6x3 


W6]  :  is  a  6x6  coefficient  matrix. 


The  gyro  measurement  model  is  given  by  (see  equation  (A-1.22)): 

zMqjjJ/hvM+l'1  +vM+vM 

_5  L  ^J-5  -gb  -gd 


Ss 


Sn 


(2-14) 
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Where: 

P 

■  m 

9  m 

rm\ :  is  a 

4M 

lvPb 

v<ib 

:is 

II 

1 - 1  -^2 

^1 

\vpd 

v‘u 

1^ 

II 

k. 

V9s 

^J:is 

vM  = 

Sn 

\VPn 

V‘ln 

Vr„Y:is 

~1 

0  0 

0  0  0 ' 

0 

0  1 

0  0  0 

0 

0  0 

0  10 

:  is  a  3x6  matrix. 


2.5  Actuation  Servo  Model 

The  dynamic  model  for  the  actuation  system  is  derived  in  Appendix  A,  equations  (A-1.23)  to 
(A-1.28).  A  second  order  linear  dynamics  is  assumed  for  the  gyro  model. 

This  equation  is  of  the  form: 


h[J] 


(2-15) 


Where: 


x-6 


M- 


Go  Go  Vo  Vo  Go  Go 


:  is  a  6x1  state  vector. 


d-fi  =  a  i  =  fe  m  CiY  :  is  a  3x1  control  (servo  actuator)  input  vector. 
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h>\= 


matrix. 


0 

0 

0 

0 


1 

■2^(0^ 

0 

0 

0 

0 


0 

0 

0 

- 

0 

0 


0 

0 

1 

2£ria,ri 

0 

0 


0 

0 

0 

0 

0 

■ODg 


0 

0 

0 

0 

1 

■2^co^ 


:  is  a  6x6  servo  actuator  coefficient 


b]= 


®! 

0 

0 

0 

0 


0 

0 

0 

a* 

0 

0 


0 

0 

0 

0 


(d£ 


:  is  a  6x3  servo  input  coefficient  matrix. 


If  the  actuator  system  noise  is  included  in  the  model  then  the  actual  output  from  the  actuator 
servo  may  be  written  as: 


/»]*l'1  +  h]«5r1  +  vW 

We  may  also  write  for  the  actuator  output: 

%  f.r-fc.bt1 

Where: 


(2-16) 


(2-17) 


vW  =  ve  Vi  v„  v~  vr  Vi  p :  is  a  6x1  actuator  servo  noise  error  vector. 

-s„  L  bn  g„  On  0 n  bn  bn* 


fo]  = 


1  0  0  0  0  0 
0  0  1  0  0  0 
0  0  0  0  1  0 


:  is  a  3x6  matrix. 


Note  that: 


«w  =  [x(..)  f(..)  z{.)  l{.)  m{.)  n{„)Y 

=  f(u,  v,  w,  p,  q ,  r,  it,  v,w,  %0 ,  tj0 ,  £0  )  =  f[d-f ,  x^\ [v2  ]x^) 


(2-18) 
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2.6  Overall  Nonlinear  (Quadratic)  Airframe  Model  including  IMU 

Equations  (A-1.5),  (A-1.17),  (A-1.21)  and  (A-1.26)  combine  to  give  us  an  overall  airframe,  IMU 
and  actuator  dynamic  model;  this  equation  is  of  the  form: 

=  +  +  +  +  (2-19) 

Where: 


i  dp  i  # r  i  dp 


:  is  a  24  xl  state  vector. 


kx6]  i 
_ 1 

kx4  i 

kx^l  i 
_ 1 

kxfil 

kxtf]  1 

_ I 

M  i 

kx<j]  i 

kxd] 

[*>]= 

- 1 

---  i 

- 1 

- :  i 

kz]  i 

_ l 

kx4  i 

k>]  i 
_ 1 

kx4 

Kx4  i 

_ | 

kx4  i 

kx4  i 

hi. 

[f2)=\foY  1 

[w2Y  i 

kix^]  i 

\Pl2x6  ]J 

Vh\-W  1 

WsY  i 

kxd]  i 

Ktf : 

[C2]=| 

1^x6  ]  1 

kxd]  i 

kxd]  i 

hfF : 

[Hi]  = 

1^x4  i 

[Wj 

i  kx4  i 

kx«i 

[h2\  = 

lo6x6]  1 

kx4  i 

kx4  i 

kxjr 

:  is  a  24x24  coefficient  matrix. 


A  block  diagram  of  the  decomposed  version  (derived  by  considering  the  sub-matrices)  of  the 
overall  model  is  given  in  Figure  A-l.l.  See  appendix  section  3. 

2.7  The  Measurement  Model 

Equation  (2-12)  and  (2-14)  may  be  combined  to  give  the  overall  airframe  and  IMU  (Gyros, 
Accelerometers)  measurement  model  (see  equation  (A-1.30)): 


#=k]^hvW+!:w+vW+vW 


(2-20) 
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Where: 


,w= 


-7  = 


[if  I  zw 

4  I  —5 
accelerometer)  measurement  vector. 

vif]=[vWr  I  JiFl'.L 


=  [ax„,  aym  azm  Pm  9m  rm]  T ■  ^  a  6x1  IMU  (gyro  + 


X*  vyb  vzb  vPb  vqb  vrh  ] 7  :  is  a  6x1  IMU  bias  error  vector. 


VW  I  vw 

~ad  1  -Si 


n  T 


=  [vxd  vyd  vzd  vpd  vqd  vrd\T  ■  is  a  6x1  IMU  drift  error  vector. 


v!']  =  vW  I  vW  =  fvv  v„  v.  v„  vn  vr  1 T :  is  a  6x1  IMU  scale  factor  error 
-S  - a ,  1  -e.  L  ys  zs  ps  qs  rs  j 


vector. 


-n 


wr  I  vWrlr  =  L 

a„  1  -g„  L 


VL 


VZn  VPn  Vqn  Vr, 


J- 


is  a  6x1  IMU  noise  error  vector. 


?3x6  I  J1  I  ^3x6 
?3x6  I  °3x6  I  J  2 


9  3x6 


9  3x6 


:  is  a  6x24  matrix. 


3.  Linearised  State  Space  Airframe  Model 

The  linearised  state  space  model  is  derived  in  Appendix  A,  section  2  (equations  (A-2.1)  to 

(A-2.9).  It  is  assumed  that  X ,  Y ,  Z ,  L ,  M  and  A  are  functions  of  u,v,w,p,q,r,u,v,w^,Tj,g 
and  first  order  linearization  of  these  nominal  values  Uo,  Vo,  wo,  po,  (jo,  n,  §o,  T]o  and  go,  are 
considered.  The  linearised  airframe  model  is  given  by: 

The  'small'  perturbation  model  for  the  quadratic  dynamic  model  of  equation  (A-1.29)  may  be 
written  as  (see  equation  (A-2.5)): 

=  [Fj]AxP  +  [F2E4  +  GjE0\AxW  +  [GjE2]  Axfi  +  [CjE^A^f 
dt  dt  (3-1) 

+[g2WjU[h2]av^ 

*n 

This  equation  will  be  referred  to  as  the  decomposed  form  (see  Appendix  A  section  3) 


13 


DSTO-TR-1990 


Where: 


\f2e4  +  G,E0]  = 


\f0E4  +  GqEq] 

~[g0e2] 

~[g0e3]~ 

[w2e4  +  w3e0] 

;  [GiE2]  = 

[w3e2] 

;  [g,e3]  = 

[w3e3] 

[°6x6  ] 

[°6x6  ] 

[°6x6  ] 

[°6x6  ] 

.  [°6x6  ] 

.  [°6x6  ]  _ 

Equation  (3-1)  may  be  written  in  a  compact  form  as: 
=  [F5]Ax$  +  [g3]Au$  -*{H3]AvW 


(3-2) 


Where: 


*« 

xw 

XP 

xq 

Yu 

Yv 

Yw 

fP 

i 

Yr 

[E0] 

|  = 

Zu 

zv 

Z  yv 

zP 

z, 

Eu 

Ev 

EyV 

LP 

h 

Lr 

Mu 

My 

Mp 

Mq 

Mr 

Nu 

Nv 

N  yv 

NP 

N * 

Nr_ 

~x4 

Xr, 

V 

% 

h 

% 

[eA 

\  = 

h 

h 

Ln 

h 

h 

:  is  a 

6x3  control- 

Mg 

Mr, 

Mg 

Ng 

Nr, 

NS 

[El] 

\  = 

\e,v2 

] :  is  a  6x6  matrix. 

Nw 

0  0 

o 

Yu 

Yv 

Yyv 

0  0 

0 

[e3] 

_ 

zu 

Zv 

Z  yv 

0  0 

0 

:  is 

a  6xf 

Eu 

Ev 

Eyv 

0  0 

0 

Mu 

Mv 

Myy 

0  0 

0 

-Nu 

Nv 

N  yv 

0  0 

0 

:  is  a  6x6  aero-derivative  matrix. 


:  is  a  6x6  aero-derivative  matrix. 
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< lo 

0 

0 

0 

u0 

0  ' 

r0 

0 

0 

0 

0 

u0 

0 

Po 

0 

v0 

0 

0 

0 

r0 

0 

0 

0 

v0 

0 

0 

Po 

w0 

0 

0 

[E4}  = 

0 

0 

<lo 

0 

w0 

0 

:  is  a  12x6  matrix  of  steady  state  values. 

0 

0 

0 

2Po 

0 

0 

0 

0 

0 

<10 

Po 

0 

0 

0 

0 

r0 

0 

Po 

0 

0 

0 

0 

2qo 

0 

0 

0 

0 

0 

r0 

qo 

0 

0 

0 

0 

0 

2r0 

[I24x24]~[GiE 

3  1 

024x6 

1 

024x6  1  024x6  ] :  is  a  24x24  coefficient  matrix. 

IfA=\ 

[FlWz 

E4  +  GjEq 

i  024x6 

1  024x6  |  024x6\'.  is  a  24x24  coefficient  matrix. 

[FsWFsVfo]  :  is  a  24x24  coefficient  matrix. 
tohlFsPfa]  :  is  a  24x3  coefficient  matrix. 

[h  3  ]  =  [f3  [h 2 ]  :  is  a  24x3  coefficient  matrix. 

3.1  Linearised  Measurement  Model 

Small  perturbation  model  of  the  measurement  model  (see  equation  (A-1.30)  may  be  written  as: 

=  \j6  ]  +  Avffl  -t-dv^  +  dy^  +  dy[^  (3-3) 

A :  denotes  small  perturbation  about  nominal  values 

Finally,  linearising  the  output  equation  (2-10)  (see  also  equation  (A-l.ll))  gives  us: 

4y  M  =  [j7  ]  dy  +[L0  ]Au (3-4) 

Where: 

[jy  ]  =  \j o  +K0E4  ] ;  is  a  6x6  coefficient  matrix. 
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4.  Conclusions 


Both  the  non-linear  and  linearised  autopilot  models  have  been  derived  in  this  report.  The 
state-space  model  of  a  missile  autopilot  needs  to  be  validated  by  comparing  the  model  with 
the  other  published  results,  and  through  both  open  and  closed-loop  systems  simulation.  The 
non-linear  dynamics  model  presented  as  structural  quadratic  algebraic  system  is  novel  and 
will  be  used  for  developing  non-linear  control  techniques  suitable  for  missile  systems  high  g- 
manoeuvres  and  operating  of  a  range  of  aerodynamics  conditions.  The  models  developed  in 
this  report  are  useful  for  applications  to  precision  optimum  and  adaptive  guidance  and 
control.  It  is  hoped  that  the  higher  order  model  with  motion  and  inertial  coupling  will  provide 
more  accurate  representation  of  autopilot  dynamics  particularly  for  non  axis-symmetric 
airframes  that  could  be  used  for  adaptive  and  integrated  guidance  &  control  of  missiles  such 
as  air  breathing  supersonic  and  hypersonic  vehicles. 
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Appendix  A: 


A.l.  Non-linear  (Quadratic)  Airframe  and  IMU  Dynamics 


Equations  (2-1)  to  (2-3)  represent  the  force  equations  of  a  generalised  rigid  body  and  describe 
the  translational  motion  of  its  centre  of  gravity  (c.g)  since  the  origin  of  the  vehicle  body  axes  is 
assumed  to  be  co-located  with  the  body  c.g.  Equations  (2-4)  to  (2-6)  represent  the  moment 
equations  of  a  generalised  rigid  body  and  describe  the  rotational  motion  about  the  body  axes 
through  its  c.g.  Separating  the  derivative  terms  and  after  some  algebraic  manipulation. 
Equations  (2-1)  to  (2-3)  may  be  written  in  a  vector  form  as: 


0  0  0  1  0 
0-1  0  0  1 
1  0  -100 


Where: 


-1 

uq 

x+f 

Sx 

0 

ur 

+ 

Y 

+ 

gy 

0 

vp 

vr 

wp 

wq 

Z 

_&z  _ 

(A-l.l) 


Note:  that  in  the  above  equations,  the  states  (u,  v,  w,  p,  q,  r)  appear  as  a  quadratic  form 
expression. 

In  matrix  notation  equations  (2-4)  to  (2-6)  (section.2)  may  be  written  as: 


p 

V 

'  L~ 

0 

=[*»] 

pq 

+ 

M 

r 

pr 

N 

02 

qr 


(A-1.2) 


Here  again,  the  states  (p,q,r)  appear  as  a  quadratic  form  expression. 
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Where: 


k]= 

I XX 

$ 

1 

£ 

1 

~  I  xy 

I  yy  lyz 

:  is  a  3x3  matrix. 

—  I  zx 

~  I  yz  I  zz 

M= 

0 

1 zx 

I  xy 

tyz  {lyy  hz) 

—  I  zx 

I  yz  V  zz  Ixx ) 

0  Ixy 

I  xy 

\  xx  I  yy) 

I  yz 

—  Ixy  —  I  zx 

:  is  a  3x6  matrix. 


Equation  (A-1.2)  may  also  be  written  as: 


d 

dt 


p 

P2 

'  L~ 

q 

=  [A0nB0] 

pq 

+M1 

M 

r 

pr 

N 

q2 

qr 

r2 

(A-1.3) 


Where: 


[lyy^zz  lyz  )  i/.zz^xy  +  lyz^zxj  ^fyz^xy  +  lyy^zx) 
{fzz I xy  +  lyz^zx)  \fxx^zz  ~  ^zx  )  {fpcx^yz  +  ^zx^xy) 


ij  yz^  xy  +  I  yy  I  zx  )  (J 


I xx^ yz  ^xy^zx 


)  ( 


I  xx^  yy  I  xy 


7 


:  a  3x3  matrix. 


A-\J  J  J  -T  J  ‘  —  /  J  2  —  1  T  2-2I  T  J 

*—*  VV  1  in? 1  77  ■*  VV  1  1>7  ■*  1?1?  1  7 V  *  77-1  n?  •*  1?7J  7V*  V 


lXX"JJ^ZZ  XT'  jz 


1  zz^  Xy 


1  jz^zx^xy 


) 


The  selection  of  the  particular  order  of  the  terms  in  the  'quadratic-state'  vectors 

[uq  ur  vp  vr  wp  wqY  of  Equation  (A-l.l)  and  jp2pq  pr  q2qr  r2  of  Equation  (A-1.2)  is  made  on 
the  basis  of  retaining  lexicographic  order  of  the  variables.  Combining  Equations  (A-l.l)  and 
(A-1.3),  we  obtain  the  full  6th  order  rigid  body  dynamics  state  equations  as: 


d 

■# 

>,] 

[°3x6\ 

'# 

+ 

hxi] 

[03x3\ 

— 

'# 

+ 

§ 

dt 

i7] 

\p3x6  ]  1 

ki-'W 

~s 

[°3x3\ 

1  [AoV 

0 

(A-1.4) 
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Where: 

0  0  0  1  0  -1 

[Q]=  0-1001  0  :  is  a  3x6  matrix. 

1  0  -100  0 

=  [m  v  it’]7  :  is  a  3x1  linear  state  vector. 

i'l -[p  »  rY  :  is  a  3x1  linear  state  vector. 

x^  -  [«</  ur  vp  vr  wp  wqY :  is  a  6x1  quadratic  state  vector. 

— ^~\p2  PO  Pr  O2  (P  •  *s  a  6x1  quadratic  state  vector. 

m^  =  [.Y  +  J  Y  zf :  is  a  3x1  'force'  input  vector. 

=  [/.  M  A']7  :  is  a  3x1  'moment'  input  vector. 
g  =  [gx  8y  8z  F  :  is  a  3x1  gravity  vector. 

Note:  superscript [1]  is  used  to  indicate  that  the  state  vector  is  linear;  while  superscript 121  is 
used  to  indicate  that  the  state  vector  is  a  quadratic/ bilinear  form. 


Equation  (A-1.4)  may  be  written  in  a  compact  form  as: 


(A-1.5) 


Where: 

m 

xj^  =  —  =[m  v  ir  |  p  q  rY  '■  is  a  6x1  linear-state  vector. 
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—3  ~ 


[2] 

2 

state  vector. 


*2 


=  ^uq  ur  vp  vr  wp  wq  \  p 2  pq  pr  q2  qr  r2^ :  is  a  12x1  quadratic- 


Hi 


W 


& 

and  moments. 


=h 


X+T  Y  Z  \  L  M  Nf  :  is  6x1  a  vector  function  of  control  inputs,  forces 


pi- 


g 


'-3x1 


[?*  Sy  §z  ^  ^  o\  :  is  the  6x1  gravity  (or  disturbance)  vector. 


[C0]  I  [03x6] 

[°3x6\  I  \A<)\  1[Bo] 


:  is  a  6x12  state-coefficient  matrix. 


fob 


[^3xi]  I  [^ixi] 

[^3x3 ]  I  \Ao\  1 


:  is  a  6x6  input-coefficient  matrix. 


Subscripts  under  [ Z]  and  [0]  matrices  denote  the  matrix  dimensions. 


A.1.1  Body  Acceleration  Model 

Generally,  not  all  state  variables  in  the  state  equation  are  accessible  or  measurable.  The 
common  accessible  measurement  variables,  in  most  missiles  or  airplanes,  are  the  angular  rate 
components  (roll  rate  p,  pitch  rate  q,  and  yaw  rate  r)  and  the  acceleration  components  (ax,  ay, 
az).  The  acceleration  components  at  point  O  (where  O  is  at  a  distance  of  dX/  dy  and  dz  from  the 
central  point  of  gravity,  c.g.,  along  x-,  y-  and  z-axis,  respectively),  may  be  written  as  [11]: 

2  2 

ax  =  u  +  qw-rv-dx(q  +  r  )  +  dy(pq-r)  +  dz(pr  +  q) 

=  X  +  T  +  gx-dx(q2+r2)  +  dy(pq-r)  +  dz(pr  +  q)  (A-1.6) 

ay=v  +  ru-  pw  +  dx(  pq  +  r  )-dy(  p  +r  )  +  dz(qr-  p) 

=  Y  +  gy  +  dx(pq  +  r)-dy(p2  +  r2)  +  dz(qr-p)  (A-1.7) 
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az  =  w  +  pv-qu  +  dx(pr-q)  +  dy(qr  +  p)-dz(p2  +  q2  ) 
=  Z  +  gz  +  d  x  (  pr  -  q  )  +  dy  (qr  +  p)  -  dz  ( p 2  +  q 2  ) 


(A-1.8) 


Or  in  matrix  form:^ 


(A-1.9) 


Where: 

=  [ax  a  y  «z] T  :  is  a  3X1  body  acceleration  vector. 


10  0  0 
0  1  0  -dz 
0  0  1  dy 


d z 
0 

~  d  X 


dx 

0 


:  is  a  3x6  accelerometer  'offset'  matrix. 


M= 


0  0  0  -1 
0  10  0 
-10  10 


0  10 
-1  0  -dy 

0  0  -d. 


'offset'  matrix. 


dy  dz 

dx  0 
0  dx 


0 

d. 


:  is  a  3x12  accelerometer 


Substituting  from  equation  (A-1.5)  for  the  — L]  term  in  the  above  equation  gives  us: 

dt 


§ 

[d0F0  +  Dj\ 

+  \DoGo\ 

0 

y\l]  =  \PqFq  +  d^] + [D(,GoW  +  Kk[,] 

Now,  the  expression  for  the  body  rates  is: 

y^ 1  =  \p  q  rY  '■  is  a  3X1  body  rate  vector. 


(A-1.10) 
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Combining  this  with  equation  (A-1.10)  gives  us: 


\m 

[°3x6\ 

JA  + 

1 

’-i 

C) 

+ 

1 _ 

J2]  + 

[DqGoY 

J?]  + 

-[DoY 

_[°3x3  1  ^ixi]. 

—3  + 

[°3xl2\ 

—3  + 

_  [^3x6  ]  _ 

U3  + 

h?xtf]_ 

4 

i'1  = 


(A-l.ll) 


Where: 


M- 


[k0]= 


[M0]  = 


h 


:  is  a  6x1  output  vector. 


[°3x6] 


[°3x3  I  ^ixi], 

I .D0F0  +  DlYxl2 

\P3xl2  ] 


:  is  a  6x6  linear-state  output  coefficient  matrix. 


:  is  a  6x12  quadratic-state  output  coefficient  matrix. 


[DoGo]3x6 

[ 9 3x6  ] 
\Po  ]jx6 
.  [°3x6\ 


:  is  a  6x6  coefficient  matrix. 


:  is  a  6x6  output  coefficient  matrix. 


Note:  equation  (A-l.ll)  represents  the  actual  accelerations  and  body  rates  outputs;  these  have 
to  be  measured  using  a  body  fixed  IMU  (accelerometers  and  gyros). 


A.1.2  Accelerometer  and  Gyro  Dynamics 

Let  us  assume  a  second  order  dynamics  for  the  accelerometers  and  gyros  respectively;  thus: 


aao  _  _ 03 a _ 

aa  (s2  +  +  ®«) 


a  =  x,y,z 


(A-1.12) 
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c Or 


Mo  =  WJLl _ 

(s2  +  +  cojj 


); 


p  =  p,q,r 


(A-1.13) 


(g),C)  :  denote  the  sensor  natural  frequency  and  the  damping  factor  respectively.  Subscript  'o' 
denote  output  values,  and  subscripts  ( x,y,z )  and  ( p,q,r )  denote  accelerations  and  body  rates 
measured  by  accelerometer  and  gyro  orthogonal  triads  respectively. 


A.1.3  A.1.3  Accelerometer  Dynamics 

In  state  space  form  equations  for  the  accelerometer  may  be  written  as: 


d 

dt 


~axo~ 

• 

aXO 

ayo 

• 

— 

a  yo 

azo 

• 

a  zo  _ 

0 

0 

0 

0 


~2Cx“>x 

0 

0 

0 

0 


0 

0 

0 

-a>y  - 
0 
0 


Where:  aao  =^r(tao;  a  =  x,y,z 
dt 

This  equation  is  of  the  form: 


0 

0 

1 

Ky®y 

0 

0 


0 

0 

0 

0 

0 

-ml  - 


0 

0 

0 

0 

1 

2Zz°>z 


axo 

Qxo 

ayo 


a 


yo 

azo 

azo 


+ 


®.v 

0 

0 

0 

0 


0 
0 
0 
C Oy 
0 
0 


0 

0 

0 

0 

0 

(O- 


(A-1.14) 


(A-1.15) 


Where: 


-mx 

0 

0 

0 

0 


1 

~2Cx^x 

0 

0 

0 

0 


0 

0 

0 

0 

0 


0 

0 

1 

-KyVy 

0 

0 


0 

0 

0 

0 

0 

-CO2,  - 


0 

0 

0 

0 

1 

Kz«>z 


is  a  6x6  coefficient  matrix 


containing  accelerometer  parameters. 
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k/]= 


:  is  a  6x3  coefficient  matrix  containing  accelerometer  parameters. 


m= 

—4 


0  0  0 

co2x  0  0 

0  0  0 

0  COy  0 

0  0  0 

0  0  co2 


^XO  d  XO  ^  yo  M  yo  go  d  ZO 


:  is  a  6x1  accelerometer  state  vector. 


Substituting  for  from  equation  (A-1.10)  into  equation  (A-1.15),  we  get: 

+  [WiD0F0  +W1D1\ J-f  +  [WjD0G0]J-f  +  [tVjDojgW  (A-1.16) 


dt 


=  M  $  +  +  lw3\$  +  [w4]gW 


(A-1.17) 


Where: 

[^2  ]  =  [w7 iD()F()  +WjDj  ]:  is  a  6x12  coefficient  matrix. 
[fVj  ]  =  \fVjD0G0 ] :  is  a  6x6  coefficient  matrix. 

[fV4  ]  =  \fVj  Df)  ] :  is  a  6x6  coefficient  matrix. 

The  measurement  model  is  given  by: 

$  =  \J,  ]*W+VW  +  VW  +  VW+VW 

- 4  l  1 1—4  -ah  -a,,  -as  -an 


Where: 

ZW- 
u  ~ 

a  Y 

L  "v/;; 

flrm 

m  . 

|^  :  is  a  3x1  accelerometer  measurement  vector. 

~ab 

k* 

-J 

:  is  a  3x1  accelerometer  bias  error  vector. 

II 

s? 

^1 

k„ 

:  is  a  3x1  accelerometer  drift  error  vector. 

vW  = 

~as 

W-,v 

V.»’,v 

-,r 

:  is  a  3x1  accelerometer  scale  factor  error  vector. 

(A-1.18) 
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vl  J  =  vv  v.,  v.  r  :  is  a  3x1  accelerometer  noise  error  vector. 
L  xn  yn  zn  J 

~1  0  0  0  0  o' 

\j l\=  0  0  1  0  0  0  :  is  a  3x6  matrix. 

0  0  0  0  1  0 


A.1.4  Gyro  Dynamics 

Similarly,  state  space  form  equations  for  the  gyros  may  be  written  as: 


(A-1.19) 


Where: 

*  d 

JU°  =  dtJU°;  M  =  p,q,r 
Equation  (A-1.19)  is  of  the  form: 

Jt*[5]  =  [w5U[5]  +  [w6W  (A-1-20) 

jt^]  =  [ws]x^  +  [o6x3  |  W6]x$ 

^=[ws]^+[w7]  J-f  (A-1.21) 
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Where: 


4]-l 

Pm 

111 

r  F 

‘m  J 

:  is  a  3x1  gyro  measurement  vector. 

II 

S&S 

^1 

\VP„ 

V% 

v',f 

r 

:  is  a  3x1  gyro  bias  error  vector. 

Sd 

lvn« 

V<ld 

'’■J 

T 

:  is  a  3x1  gyro  drift  error  vector. 

vW  = 

&S 

yps 

V<ls 

-J 

:  is  a  3x1  gyro  scale  factor  error  vector. 

vW  = 

Sn 

\VPn 

V<ln 

"J 

T 

:  is  a  3x1  gyro  noise  error  vector. 

1  0  0  0  0  0 

0  0  10  0  0  :  is  a  3x6  matrix. 

0  0  0  0  1  0 
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A.1.5  Actuation  Servo  Model 


Let  us  assume  a  second  order  dynamics  for  the  actuators,  that  is: 


_ , 

ai  (s2  + 


(A-1.23) 


(i o>a  ,£a):  denote  the  sensor  natural  frequency  and  the  damping  factor  respectively;  subscript 
T  denotes  the  servo  (control)  input  value  (servo  demand),  and  subscripts  (^,  77,  £")  denote  roll, 
pitch,  and  yaw  outputs  from  the  servo. 

In  state  space  form  equations  for  the  actuation  system  model  may  be  written  as: 


d 

dt 


'So' 

• 

So 

% 

• 

= 

f?o 

So 

• 

.So. 

■  ©| 
0 

0 

0 

0 


1 

-2^(0% 

0 

0 

0 

0 


0 

0 

0 

co^ 

0 

0 


Where: 

#  d 

a  =  —a;  a  = 

dt 


This  equation  is  of  the  form: 


0 

0 

1 

■  2ir10>71 
0 
0 


0 

0 

0 

0 

0 

■  ©I 


0 
0 
0 
0 
1 

-2^(Or 


1 

1 

^  • 

'  0 

0 

0  ' 

So 

COg 

0 

0 

Vo 

0 

0 

0 

• 

Vo 

+ 

0 

a2 

0 

So 

0 

0 

0 

• 

0 

0 

coi 

.So. 

b  _ 

Si 

Vi 

Si 


(A-1.24) 


(A-1.25) 


Where: 

Ji]_ 

^6  ~ 


:  is  a  6x1  state  vector. 


Vo  Vo  £o  ^0  0 

=  a i  =  \%i  r/i  Y :  is  a  3x1  control  (servo  actuator)  input  vector. 
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[Vo\= 


matrix. 


■<y| 

0 

0 

0 

0 


1 

■  jzCDj: 

0 

0 

0 

0 


0 

0 

0 

0 

0 


0 

0 

1 

2  ^rj(Orj 
0 
0 


0 

0 

0 

0 

0 

■a>g 


0 

0 

0 

0 

1 

■2^co^ 


:  is  a  6x6  servo  actuator  coefficient 


[Vj]  = 


0  0 


COg 


0  0 


0  0 

0  6 Oi ? 

0  0 


0 

0 

0 


0  0  co, 


'c 


:  is  a  6x3  servo  input  coefficient  matrix. 


If  the  actuator  system  noise  is  included  in  the  model  then  the  actual  output  from  the  actuator 
servo  may  be  written  as: 


We  may  also  write  for  the  actuator  output: 

ii'Mf.  io  iJ=[v2W 

Where: 


(A-1.26) 


(A-1.27) 


v^  =  lv/:  Vi  v„  v~  Vr  vi-  \  :  is  a  6x1  actuator  servo  noise  error  vector. 

-s„  L  bn  c,„  On  On  bn  <,„! 


h]= 


1  0  0  0  0  0 
0  0  1  0  0  0 
0  0  0  0  1  0 


:  is  a  3x6  matrix. 


Note  that: 


=  [*(..)  ?(..)  z{.)  l{.)  m(.)  7V(..)f 

=  f(u,  v,  w,  p,  q,  r,  it,  v,w,  ,  ij0 ,  £0  )  =  f[d-f  ,x\j\ [v2  ]*^) 


(A-1.28) 


A.1.6  Non-linear  Airframe,  IMU  and  Actuator  Dynamic 

We  can  now  combine  equations  (A-1.5),  (A-1.17),  (A-1.21)  and  (A-1.26)  to  give  us  an  overall 
airframe,  IMU  and  actuator  dynamic  model;  this  equation  is  of  the  Form: 
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vW  (A-1.29) 


Where: 


1 

*wr  i 

—4  1 

^  i 

1* 

i _ i 

'[«»»>]  1 
_ 1 

kx6]  i 

Kx«]  i 
_ 1 

kxd] 

kx4  i 

_ 1 

k]  i 

kxtf]  i 

kx4 

kb  —  i 

---  i 

- 1 

— 

k]  i 

_ l 

kxfi]  i 

k]  i 
_ 1 

kxfi] 

_kx4  i 

_ | 

kx6]  i 

kxtf]  i 

k]_ 

k.]=hr  i 

kf  1 

kixd] 

\Pl2x6 

[G,]=tc»r  i 

kF  i 

kx^]  i 

kxj] 

ta]  =  ["<*]  1 

kxd]  i 

kx4  i 

hr]7 

kF 

i  kxd 

1  [°6x6 

[«j]=[KJ  1 

kxd] 

i  kx6]  i 

kxd] 

is  a  24  xl  state  vector. 


:  is  a  24x24  coefficient  matrix. 


A  block  diagram  of  the  decomposed  version  (derived  by  considering  the  sub-matrices)  of  the 
overall  model  is  given  in  Figure  A-l.l.  See  appendix  section  3. 


A.1.7  Measurement  Model 

Equations  (A-1.18)  and  (A.1.22)  may  be  combined  to  give  the  overall  measurement  model: 

(A-1.30) 
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Where: 


,w= 


7  L  J  — 

—7 


i  T 


Wr  I  M7 

4  I  —5 
accelerometer)  measurement  vector. 

v^4vWr  I  J«Flr.L 

~b  I  -a*  1  L 


=  [«X,„  «>•„,  azm  Pm  9m  rm]  T:  is  a  6x1  IMU  (gyro  + 


vyb  vzb  vPb  vqb  Vrj  7  :  is  a  6x1  IMU  bias  error  vector. 


,[?] 


vbJ  = 


vW7  I  vW7 

~ad  1  -Srf 


nr 


%  Vyd  vzt,  vPd  vqd  V»v  ] 7  :  is  a  6x1  IMU  drift  error  vector. 


vW  =  vW  I  vW  =  L  v.,  v.  v„  v,,  v,.  1 7 :  is  a  6x1  IMU  scale  factor  error 

-S  - a .  1  L  xs  ys  zs  ps  qs  rs  j 


vector. 


vW  = 

-a 


„Mr  I  vw 

~an  '  Sn 


1  T 


=  k, 


v.»’„  V  vr. 


•  ]7 : 


is  a  6x1  IMU  noise  error  vector. 


' 3x6 


°3x6  I  °3x6 


J 1  I  #3x6 

I  -- 

I  J2 


’ 3x6 


’ 3x6 


:  is  a  6x24  matrix. 


A.2.  Linearised  Airframe,  Actuation  and  IMU  Dynamics 

Equation  (A1.30)  defines  the  complete  non-linear  description  of  the  full  6-DOF  airframe 
model.  These  equations  contain  quadratic  terms  in  states  and  will  be  classed  as  the  quadratic 
dynamic  model.  This  type  of  model  is  required  when  autopilot  design  is  undertaken  for  a 
missile  executing  high  g-  or  high  angle  of  attack  manoeuvres,  and  (u,  v,  w,  p,  q,  r)  are  not 
small.  A  more  detailed  consideration  of  the  algebraic  structure  of  this  type  of  dynamic 
systems  is  given  in  [4]. 


A.2.1  Linearised  Aerodynamic  Forces  and  Moments 

Assuming  that  X ,  Y  ,  Z ,  L,  M  and  TV  are  functions  of  u,v  ,w ,  p,q,r  ,u,v  ,w  %  ,rj  ,g  and  using 
first  order  linearisation  about  the  nominal  values  Uo,  Vo,  Wo,  po,  qo,  Vo,  §o,  qo  and  go,  we  get: 
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AJ-f  = 


’dA  +  df" 

Xu 

*P 

*9 

xr 

Au 

xv 

Xg 

dF 

yw 

?P 

Yr 

Av 

dZ 

zv 

Z  w 

Zp 

Zr 

Aw 

+ 

h 

Zr, 

Zg 

AL 

K 

Lv 

Ew 

LP 

A i 

Lr 

Ap 

Lt 

h 

h 

AM 

Mu 

Mv 

Mw 

Mp 

Mq 

Mr 

Aq 

Mg 

Mr, 

Mg 

AN 

Xu 

Xv 

Xw 

NP 

N 9 

Nr_ 

Ar 

Ng 

Nn 

nA 

Ari0 


Xu 

Av 

Xw 

0 

0 

o' 

Ail 

Yu 

Yv 

Y* 

0 

0 

0 

Av 

Zu 

Zr 

Z  w 

0 

0 

0 

Aw 

Lu 

Lv 

Y\v 

0 

0 

0 

Ap 

M„ 

M^ 

0 

0 

0 

Aq 

Xu 

Xr 

Xw 

0 

0 

0 

Ar 

(A-2.1) 


This  equation  may  be  written  as: 

Au^  =  [E0Wf  +[EjV2]AxW  +[E3]^-AJf 


dt 


^^[e0]^4e2uJMe3]^M] 


dt 


(A-2.2) 


Where: 


4-):  denotes  'small'  deviations  from  the  normal  steady-state  condition 

(see  Tables  A-l.l  -  Al-3): 

~  dX  •  •  •  ~  dY  •  •  • 

Xa  =  a  =  u,v,w,p,q,r,u,v,w^,rj,g ;  Ya  =  —  ;  a  =  u,v,w,p,q,r,u,v,w£,ri,g 

da  da 

~  dz  •  •  •  _  dL  •  •  • 

Za  =  — — ;  a  =  u,v,w,p,q,r,u,v,wg,Tj,g;  La  =— ;  a  =  u,v,w,p,q,r,u,v,wg,rj,g 
da  da 

Ma  =  — — ;  a  =  u,v,w,p,q,r,u,v,wg,?j,g;  Na=—;  a  =  u,v,w,p,q,r,u,v,wg,i),g 
da  da 


\_E 2  ]  =  [fi/t  ?  ] :  is  a  6x6  matrix. 

df  =  0;  d^  =  0 
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[E0]  = 


[Elh 


[e3]= 


~XU 

Xv 

xw 

Xr~ 

Yu 

% 

Yw 

fP 

] 

r. 

%■ 

Zu 

zv 

Z\V 

zP 

Z, 

K 

Lv 

Lw 

LP 

L, 

Lr 

Mu 

My 

Mw 

Mp 

Mq 

Mr 

_Nu 

xv 

xw 

*P 

N0 

xr_ 

Xrj 

V 

h 

Lt 

Z* 

Ln 

h 

h 

:  is  a  6x3  control- 

Mrj 

Mg 

Ng 

N , 

nA 

xw 

0  0 

o' 

Yu 

% 

Yjy 

0  0 

0 

Zu 

Zu 

Z  w 

0  0 

0 

:  is 

a  6x6 

Lu 

Li, 

L\v 

0  0 

0 

MU 

My 

Mw 

0  0 

0 

-Nu 

Xi, 

xw 

0  0 

0 

:  is  a  6x6  aero-derivative  matrix. 


A.2.2  Linearisation  of  the  Quadratic  State  Vector 

It  is  easily  verified  the  first  order  linearization  of  the  quadratic  state  vector  defined  in  section 

2.1. : 


—7 


[2}T  | 

may  be  written  as: 

=  [e4\Aj$ 


i  T 


=  \ 


\uq  ur  vp  vr  wp  wq 


2  2  2 

P  P<1  Pr  <1  qr  r 


(A-2.3) 
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Where: 


no 

0 

0 

0 

u0 

0  ' 

ro 

0 

0 

0 

0 

u0 

0 

Po 

0 

v0 

0 

0 

0 

r0 

0 

0 

0 

v0 

0 

0 

Po 

W0 

0 

0 

[E4]  = 

0 

0 

<lo 

0 

W0 

0 

:  is  a  12x6  matrix  of  steady  state  values. 

0 

0 

0 

2Po 

0 

0 

0 

0 

0 

no 

Po 

0 

0 

0 

0 

r0 

0 

Po 

0 

0 

0 

0 

2no 

0 

0 

0 

0 

0 

r0 

no 

0 

0 

0 

0 

0 

2r0_ 

Ax^f  -- 

H\ 

X 

i _ i 

n 

1 

T  _ 

\Au 

Av  Aw  |  Ap  Aq  Ar\ T  :  is  a  6x1  linear  A  -state  vector. 

A.2.3  Linearised  Airframe,  IMU,  Actuator  Model 

The  'small'  perturbation  model  for  the  quadratic  dynamic  model  of  equation  (A-1.29)  may  be 
written  as: 


(A-2.4) 

Substituting  for  and  Au^  from  equations  (A-2.2)  and  (A-2.3),  gives  us: 


= [f,]a^ + [f2e4  +  o,e„]a^ + [g,e2]  Axfi + [G,E3]j'A^ 

4g2w1M«2W[‘] 

Where: 


\f0E4  +  GqEq] 

-[g0e2] 

~[g0e3] 

0;  [F2E4+GjE0]  = 

[w2e4  +  w3e0] 

\GlE2]  = 

[w3e2] 

\GlE3]  = 

[w3e3] 

[°6x6  ] 

\°6x6  ] 

[°6x6  ] 

[°6x6  ] 

.  [°6x6  ]  . 

.  [°6x6  ]  . 

35 


DSTO-TR-1990 


These  above  matrices  are  all  of  dimension  24X6.  See  also  the  block  diagram  Figure  A-1.2. 
Now,  Equation  (A-2.5)^ 

^Ax^  =  [f1\Ax^  +  If2E4  +  G1E0]  |  [024x6]  |  [ 024x6 ]  |  [GjE^AxW 


+  [^2] ^"^+[[(7, E3\  1  [024x6]  |  [o24x6\  1  Fwxtf]]— 

+  [h2]AvW 

3 n 

(A-2.6) 

* 

^[F3V^7]  =  [F4U^7]  +  b2]d«t/]  +  [h2W!} 

(A-2.7) 

(A-2.8) 

=b>]4,] + 

(A-2.9) 

Where: 

[F3h[l24,24]-[GlE3  I  0 24x6  I  0 24x6  I  ^24x6^  a  24x24  coefficient  matrix. 

[f4]=[f1]+[f2e4+g1e0  I  0 24x6  I  0 24x6  I  £2  ] :  is  a  24x24  coefficient  matrix. 
IfsHfsY'IfA  :  is  a  24x24  coefficient  matrix. 

:  is  a  24x3  coefficient  matrix. 

[h3]=[f3]-1[h2\  :  is  a  24x3  coefficient  matrix. 

Small  perturbation  model  of  the  measurement  model  (see  equation  (A-1.30)  may  be  written  as: 
Azfi  =  [j6  ]Axfi  +  ^  +Avfi  +  Av^  +  Avft  (A-2.10) 

A  :  denotes  small  perturbation  about  nominal  values. 


36 


DSTO-TR-1990 


Finally,  linearising  the  output  equation  (A-l.ll)  gives  us: 

4f[/]  =  [J0  +k0e4\ax W 

Where: 

[j7  ]  =  \.J q  +K0E4  ] :  is  a  6x6  coefficient  matrix. 


(A-2.11) 

(A-2.12) 
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A.3.  Decomposed  State  Space  Models 


A.3.1  Nonlinear  Model: 

Using  the  relationship  established  in  the  appendix  section  1.4,  we  may  write: 


w 

'kxd  i 
__  __  _  | 

KxJ  1 
_______  1 

Kxd  1 
__  _  _  1 

[°6x6 1 

nwi 

'  Fd  ' 

■[^]‘ 

[°6x3 1 

[^6x6  r 

kx6  ] 

i7] 

[°6x6  ]  1 

kd  i 

[°6x6  ]  1 

[°6x6  ] 

kd 

-pb 

kd 

•Ph 

[°6x3  ] 

-Ph 

kd 

kx6  ] 

'w 

—5 

kz]  i 
_ 1 

kxd  i 
_ 1 

[W5]  I 
_ 1 

[°6x6  ] 

+ 

kxi2  ] 

kx6  ] 

[^6x5  ] 

[^6x6  ] 

kx6  ] 

1-6  J 

_[°6x6  ]  1 

[°6x6  ]  1 

kxd  ]  1 

kl_ 

J. 

_[°6xl2  ]. 

_kx6 1 

>/]_ 

_kx6 1 

_[^6x6  1 

A.3.2  Linearised  Model: 

Using  the  relationship  established  in  the  appendix  section  1.4  and  equations  (A-2.2),  (A-2.3)  and  (A-2.5),  we  may  write: 


(A3-1) 


H 

o 

H 

sa 


VO 

VO 

o 


kx6  ]  1 

kx6  ]  1 

kx6  ]  1 

\°6x6  r 

'*pr 

\f0E4  +  G^d 

~[g0e2  r 

\°6x3  r 

'[g0e3]' 

\°6x6  ] 

d 

4'1 

Kxd  1 

kd  1 

Kxd  1 

KxiS  ] 

4'1 

_L 

k^+^d 

k^d 

[°6x3  ] 

Auty  + 

[W3E3] 

iUM  + 

dt  3 

[°6x6  ] 

dt 

kz]  1 

kx6  ]  1 

k>]  1 

[°6x6  ] 

l 

kx6  ] 

kx<5  ] 

\°6x3  ] 

\°6x6  ] 

kx6  ] 

.kxd  i 

kxd  i 

kxd  i 

hi. 

kx6  ] 

.  [°6x6  ]  . 

>/]. 

_  kx6  ]  . 

\l 6x6  ]_ 

(A3-2) 

Block  diagrams  for  the  decomposed  versions  for  the  nonlinear  and  the  linearised  models  are  given  in  Figures  A-l.l  and  A-1.2  respectively 
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Table  A-l.l.  Longitudinal  (Roll)  Aerodynamic  Derivatives  and  Coefficients: 


Derivatives 

Derivatives 

Normalised  Coefficients 

Symbol 

Units 

Symbols 

Units 

Symbols 

Units 

Nnr1  sec 

- 

- 

CXu{=Xu/QSx) 

mr1  sec 

Nmr1  sec 

Xfi(=VXv) 

N 

CXp[=Xp/QSx) 

- 

Nnr1  sec 

xa{=uxw) 

N 

Cxa{=xa/QSx) 

- 

*/> 

N  sec 

- 

- 

CCTxjTqTJ 

sec 

N  sec 

- 

- 

Cxq(=Xq/&SX) 

sec 

AT,. 

N  sec 

- 

- 

C  xr  (=  Xr  /  QSX  ) 

sec 

N 

- 

- 

Cx^(=X4/QSx) 

- 

xn 

N 

- 

- 

Cx„^xt,/&SX) 

- 

XC 

N 

- 

- 

Cxc(=X£/QSx) 

- 

*u 

Nnr1  sec2 

- 

- 

CXi(=X„/QSx) 

nr1  sec 2 

Xy 

Nnr1  sec 2 

Xp^UXi) 

N  sec 

CXy{=Xi/QSx) 

m -1  sec 2 

X * 

Nnr1  sec2 

XdFuxT) 

N  sec 

nr1  sec2 

Lu 

N  sec 

- 

- 

Ciu  (=  Lu  /  QSxcx  ) 

mr1  sec 

Lv 

N  sec 

- 

- 

C[v  (=  Lv  /  QSxcx  ) 

m -1  sec 

Lw 

N  sec 

- 

- 

C  lw  (=  Lyv  /  QSxcx  ) 

m'1  sec 

h 

Nm  sec 

- 

- 

Cl p  (=  Lp  /  QSxcx  J 

sec 

Lq 

Nm  sec 

- 

- 

Cl q  (=  Lq  /  QSxcx  J 

sec 

Lr 

Nm  sec 

- 

- 

Clr  (=  Lr  /  QSxcx  ) 

sec 

Nm 

- 

- 

Cig  (=  Lg  /  QS xcx  j 

- 

Ljj 

Nm 

- 

- 

Clq  (=  Ljj  /  QSxcx  J 

- 

Ls 

Nm 

- 

- 

Clg  (=  /  QS xcx  J 

- 

LU 

N  sec2 

- 

- 

Cl-  (=  J^ii  / QS xcx) 

nr1  sec 2 

Lu 

N  sec2 

Lp{=ULv) 

Nm  sec 

Cl- (=  U  / QS xcx) 

nr1  sec2 

L\v 

N  sec2 

La{=ULw) 

Nm  sec 

Clw  (=  Lyy  /  QSxcx  ) 

mr1  sec2 

*  Q  =  -2pu2  ••(mw-'2);  ^  ••(«) 
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Table  A-2.1.  Lateral  (Pitch)  Aerodynamic  Derivatives  and  Coefficients: 


Derivatives 

Derivatives 

Normalised  Coefficients 

Symbol 

Units 

Symbols 

Units 

Symbols 

Units 

Yu 

Nm -1  sec 

- 

- 

cr„(=ru/QSy) 

m'1  sec 

Yv 

Nmr1  sec 

Y p  (-  UYV  ) 

N 

- 

Yw 

Nmr1  sec 

Ya(=UYw ) 

N 

cyJ=ra/esy) 

- 

YP 

N  sec 

- 

- 

cyr(=rp/Qsy) 

sec 

Y, 

N  sec 

- 

- 

sec 

Yr 

N  sec 

- 

- 

Cyr(=Yr/QSy) 

sec 

rf 

N 

- 

- 

cyi(=r(/QSy ) 

- 

Y, 

N 

- 

- 

- 

Y( 

N 

- 

- 

cy({=r(/esy) 

- 

Yu 

Nnr1  sec2 

- 

- 

m1  sec 2 

Yv 

Nm -1  sec 2 

Yp{=UYv) 

N  sec 

c^r./es,) 

m'1  sec 2 

Yw 

Nm'1  sec2 

Ya{=UYw) 

N  sec 

c,p=r*/Qsy) 

m1  sec 2 

Mu 

N  sec 

- 

- 

C  HI"  ^  M  U  /  QSyCy  j 

mr1  sec 

Mv 

N  sec 

- 

- 

C  mv  (=  Mv  /  QS  yC  y  J 

mr1  sec 

Mw 

N  sec 

- 

- 

Cmw[=MW  /QSyCy) 

m'1  sec 

Mp 

Nm  sec 

- 

- 

Cmp[=Mp/ QSyCy) 

sec 

Mq 

Nm  sec 

- 

- 

C  I1tq  (=  M  q  /  QS  yCy  J 

sec 

Mr 

Nm  sec 

- 

- 

Cmr[=Mr  /QSyCy) 

sec 

Mg 

Nm 

- 

- 

Clllg  (=  Mg  /  QSyCy  j 

- 

Mfj 

Nm 

- 

- 

C  (=  M  rj  /  QS  yC  y  J 

- 

Mg 

Nm 

- 

- 

Cm({ =  Mg  /QSyCy) 

- 

Mu 

N  sec2 

- 

- 

C m „  (=  M ii  /  QSycy  j 

mr1  sec2 

My, 

N  sec2 

Mp{=UMv) 

Nm  sec 

C m y  (=  M,  /  QS  yCy  J 

nr1  sec 2 

Mw 

N  sec2 

Ma{=UMw) 

Nm  sec 

Cmw[=MW  /QSyCy) 

nr1  sec2 
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Table  A-3.1.  Lateral  (Yaw)  Aerodynamic  Derivatives  and  Coefficients: 


Derivatives 

Derivatives 

Normalised  Coefficients 

Symbol 

Units 

Symbols 

Units 

Symbols 

Units 

Nnr1  sec 

- 

- 

^.(=z«/0sj 

mr1  sec 

Zv 

Nmr1  sec 

Zp{=uzv) 

N 

c^zJTqsJ 

- 

Z  w 

Nnr1  sec 

za{=uzw) 

N 

Cz„(=Za/QSz) 

- 

ZP 

N  sec 

- 

- 

CZp(=Zp/QS.J 

sec 

Z« 

N  sec 

- 

- 

Ch(=Zq/QSz} 

sec 

zr 

N  sec 

- 

- 

sec 

zs 

N 

- 

- 

c^fzJTosJ 

- 

N 

- 

- 

- 

N 

- 

- 

CH( =z</QSz) 

- 

Z  ii 

Nnr1  sec2 

- 

- 

C^ZiP  QSZ) 

nr1  sec2 

Zi 

Nnr1  sec2 

Zp{=UZv) 

N  sec 

c^Zf/esz) 

m1  sec2 

Z  w 

Nnr1  sec2 

za{=uzw) 

N  sec 

C*>Z*/0Sj 

m -1  sec 2 

N  sec 

- 

- 

Cllu{=Nu/QSzcz) 

mr1  sec 

N  sec 

- 

- 

m1  sec 

Nw 

N  sec 

- 

- 

C/in,  (=  Nw  / QSzcz) 

m'1  sec 

NP 

Nm  sec 

- 

- 

C.,(=Nr/QSzcz) 

sec 

N« 

Nm  sec 

- 

- 

c„t[=x,/eszcs) 

sec 

Nr 

Nm  sec 

- 

- 

c„,(=jv'/evJ 

sec 

Nm 

- 

- 

CHf(=Ns/QSzcz) 

- 

Nv 

Nm 

- 

- 

c„,|.=  JVevJ 

- 

Nm 

- 

- 

- 

N  sec2 

- 

- 

~c^n~7qs^) 

mr1  sec2 

N  sec2 

N^VN,) 

Nm  sec 

C„r(=Vi/QSzcz) 

mr1  sec2 

Nw 

N  sec2 

Na{=ULH,) 

Nm  sec 

Cn.{=N*/QSzcz) 

nr1  sec2 
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V,. 

A4'1 

f 

4Jl 

~6  ^ 

\/_ 

La 

J 

CM 

> 

vw+vw+vw+vw 

~ab  ~ad  ~as  ~an 


Z)= 

J 

— *IJ2=*S 

w5 

8b  ~8d  ~8s  ~8n 


Figure  A-l.l  Nonlinear  (Quadratic)  Airframe  Model  including  Actuator  and  IMU 
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+Jvw  +>w  +A,W 

— gb  — gd  — gs  — gn 


Figure  A-1.2  Linearised  Airframe  Model  Including  Actuator 
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